/*
 * ServoUnitTest.c
 *
 * Created: 1/24/2013 11:42:02 PM
 *  Author: Parag
 */ 


#include "Servo.h"


#ifndef	F_CPU
#define F_CPU 8000000
#endif



int main(void)
{
	
	ServoInit();
    while(1)
    {
		
		ConfigRightServo(South);
		ConfigLeftServo(North);
		_delay_ms(6000);
		
		ConfigRightServo(SW);
		ConfigLeftServo(NW);
		_delay_ms(3000);		
		 
		ConfigRightServo(WSW);
		ConfigLeftServo(WNW);
		_delay_ms(3000);  
		
		ConfigRightServo(West);
		ConfigLeftServo(West);
		_delay_ms(3000);		
		
		ConfigRightServo(North);
		ConfigLeftServo(South);				// to lazy to do all angles mmmhh...
		_delay_ms(4000);
		
		//Testing Rudders
		ConfigRudderServo(South);
		_delay_ms(5000);
		
		ConfigRudderServo(SW);
		_delay_ms(3000);
		
		ConfigRudderServo(WSW);
		_delay_ms(3000);
		
		ConfigRudderServo(West);
		_delay_ms(3000);
		
		ConfigRudderServo(WNW);
		_delay_ms(3000);
				
		ConfigRudderServo(NW);
		_delay_ms(3000);
		
		ConfigRudderServo(North);
		_delay_ms(3000);

	}		 
}





